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Abstract —Inertial navigation systems for pedestrians are 
infrastructure-less and can achieve sub-meter accuracy in the 
short/medium period. However, when low-cost inertial measure¬ 
ment units (IMU) are employed for their implementation, they 
suffer from a slowly growing drift between the true pedestrian 
position and the corresponding estimated position. In this paper 
we illustrate a novel solution to mitigate such a drift by: 
a) using only accelerometer and gyroscope measurements (no 
magnetometers required); b) including the sensor error model 
parameters in the state vector of an extended Kalman filter; 
c) adopting a novel soft heuristic for foot stance detection and 
for zero-velocity updates. Experimental results evidence that our 
inertial-only navigation system can achieve similar or better 
performance with respect to pedestrian dead-reckoning systems 
presented in related studies, although the adopted IMU is less 
accurate than more expensive counterparts. 

I. Introduction 

In an inertial navigation system (INS) the position of a 
mobile agent is tracked by means of an inertial measurement 
unit (IMU) carried by the agent itself. IMU-based INSs can 
provide a low-cost and infrastructure-less solution to accurate 
indoor navigation in the short/medium term. Unluckily, in 
the medium/long term they usually suffer from a “drift” 
phenomenon [1], which originates from the noise and from any 
small bias in the accelerations and angular velocities sensed 
by the IMU. 

Recently, substantial attention has been devoted to pedes¬ 
trian dead-reckoning (PDR) INSs, where the prior knowledge 
of human walking patterns is exploited to reset, at least 
partially, the accumulated errors due to various error sources 
(e.g., the time-variant biases of IMUs). This approach has 
been first proposed in [2], where the periods during which 
the pedestrian’s foot is still on the ground are detected and 
exploited to introduce some corrections (the so-called zero 
velocity updates (ZUPTs)) in the tracking filter. Further ad¬ 
vances have been developed in [1], [3]—[5]. In particular, in 
[1] and [3] an extended Kalman filter (EKF) processing IMU 
measurements exploits various heuristics to compensate for 
the drift due to time-variant biases and measurement noise. 
In [4] and [5], instead, additional measurements (from RFID 
devices) are adopted to mitigate the drift phenomenon. 


In this manuscript, starting from the methods and the results 
illustrated in [1], [6], we develop a novel INS based only 
on a low-cost IMU which performs PDR employing an EKF. 
Unlike previous approaches, the proposed solution relies on: 

1) Accelerometer and gyroscope measurements only (mag¬ 
netometer sensors are often completely unreliable in 
indoor environments and other technologies for accurate 
localization are expensive). 

2) A rigorous approach to the kinematic modelling of IMU 
measurements; this involves the use of a large EKF state 
vector, including both physical variables (e.g., agent 
position and heading) and quantities referring to the 
sensor error models (SEMs). 

3) A new soft (rather than hard) heuristic for foot stance 
detection which increases the overall accuracy of the 
INS. 

This manuscript is organized as follows. In Section II, the 
employed IMU and its calibration procedure are described. 
The proposed PDR-INS is illustrated in Section III, whereas 
its performance is assessed in Section IV. Finally, in Section 
V some conclusions are provided. 

Notations'. The probability density function (pdf) of a ran¬ 
dom vector (rv) R evaluated at the point r is denoted as 
/(r); A f (r; m, S) denotes the pdf of a Gaussian rv R having 
mean m and covariance matrix S, evaluated at the point 
r; ||x|| denotes the L 2 norm of vector x; the expressions 
{xj}f = i and xi;fc both denote the sequence xi, X 2 ,..., x*,. 
g = 9.80665 m/s 2 denotes the gravitational acceleration; 
finally, © denotes the quaternion multiplication [7], 

II. IMU Description and Calibration 

In our PDR INS a mobile agent is equipped with a low- 
cost IMU, called RazorlMU [8] and fixed on one of his/her 
feet using shoes’ laces (e.g., see [1], [3]-[5]). It is important 
to note that the IMU-sensed quantities are expressed in body 
(or sensor ) frame , i.e., they are referred to a right-handed 
coordinate frame centered on the IMU with axes parallel to 
the sensor sides; this frame is different from the so called 
navigation frame , which is a right-handed coordinate frame 
centered on some point of the navigation map and whose x 



and y axes are parallel to Earth ground and z axis points away 
from Earth. 

The RazorlMU is a programmable device equipped with 
3-axis accelerometers, gyroscopes and magnetometers; our 
firmware outputs their measurements in “raw mode”, i.e., as 
integer numbers, so that a calibration procedure is required. 
The tri-axial accelerometer calibration procedure we adopted 
is similar to that described in [9], [10], but does not require 
any additional hardware (besides the IMU itself). It relies on 
the SEM (assuming a still sensor) [9], [10] 

a m = G a a + b° + n a (1) 

where a m £ Z 3 is the vector of measured accelerations (in 
body frame), a £ l 3 is the vector of true accelerations (in 
body frame), G a £ R 3x3 is the gain matrix (diagonal if only 
scale factors are accounted for, or a generic invertible matrix 
if cross-couplings are also accounted for), b° £ R 3 is the 
bias vector, in body frame, and n“ £ R 3 is the noise vector 
(in body frame) and is assumed to be additive Gaussian noise 
(AGN) with covariance matrix S a = <r 2 I 3 . The calibration 
task for the accelerometer consists of estimating G 0 and b a 
on the basis of N ■ P measured vectors {{a’7 p }^/ 1 }^’_ 1 (in 
our setup N = 500 and P = 16), referring to P unknown 
orientations of the still sensor (in the navigation frame). The 
optimal (in the mean square error sense) estimators G a and 
b“ of the terms G a and b“ appearing in (1) are given by 

p 

(G 0 , b“) = arg min V r p (g, b, a™) ( 2 ) 

V ) (G,b )G0xB^ V ' 

where a™ is the mean of the measurements {a ™ 1 } N and 

P L bPJ l—l 

r p ^G, b, = min Ga p + b — a™ (3) 

V / Sip G A 

Once calibration is completed, the tme acceleration vector 
may be estimated as 

a = G - 1 (a m - b°) . (4) 

Regarding the gyroscopes, a SEM similar to (1), i.e., 

u> m = G,w + b w + n“ (5) 

has been exploited to devise our calibration procedure; here 
u> m £ Z 3 is the vector of measured angular velocities (in body 
frame), u> £ R 3 is the vector of true angular velocities (in 
body frame), G w £ R 3x3 is the gain matrix (diagonal if only 
scale factors are accounted for, or a generic invertible matrix 
if cross-couplings are also accounted for), b u £ R 3 is the bias 
vector (in body frame), and £ R 3 is the noise vector (in 
body frame) and is assumed to be AGN with covariance matrix 
= < 7 ^ 13 . Similarly to (4), the tme vector u> is estimated 
as 

« = G " 1 (u> m - b") ( 6 ) 

where G^and b“ denote the estimated bias vector and gain 
matrix of the gyroscope, respectively. However, unlike ac¬ 
celerometer calibration, calibration of gyroscopes requires an 


expensive dedicated hardware platform, so that b“ = 0 and 
the value provided in the gyroscope datasheet [ 8 ] for G w have 
been adopted. 

III. ThePDRINS 

Our INS performs similarly to some other navigation sys¬ 
tems described in the technical literature (e.g., see [ 1 ]), but is 
based on a different approach and, in particular, on a set of 
rigorous kinematic equations relating the quantities sensed by 
the IMU with its orientation and 3D position. After describing 
the structure of the state vector, the dynamic models and the 
measurement models, we describe the use of an EKF for 
estimating the posterior distribution of the state vector. Finally, 
we focus on a soft algorithm for foot stance detection. 

A. State Vector 

In our INS the state vector of the mobile agent wearing 
the IMU is defined as 

= [pfc,Vfc,afc,g£ > \afc,u>fc 6 >n ,bk,b£] T £ R D (7) 

where k is the time-index of the discrete-time tracking filter for 
navigation, £ ]R 3 , £ ]R 3 and a k £ R 3 are the position, 

the velocity and the acceleration of the IMU sensor, measured 
in m, m/s and m/s 2 , respectively; q^ b £ Hi is a (random) 
quaternion representing the transformation which produces, 
given a vector in navigation coordinates, a vector in body 
coordinates [7]; a^ and w/ i,>T ‘ £ R 3 are the acceleration (in 
body frame) and the angular velocity (from body to navigation 
frame, resolved in body coordinate frame [ 6 ]), measured in 
m/s 2 and rad/s, respectively; £ R 3 and b£ £ R 3 are 
the bias vectors of the accelerometer and of the gyroscope, 
expressed in body coordinate frame and measured in m/s 2 
and rad/s, respectively; finally, D = 25 is the size of x^. 

Note that: a) and cu/ i,>T ‘ are the (noisy) observable 
variables; b) all the other variables can be pseudo-observed to 
enhance the system stability whenever the foot is (approxim¬ 
ately) still; c) b/ and 1 )/' represent “fine” bias vectors, and play 
a complementary role with respect to b a and b“, respectively, 
which account for time-variant and turn-on dependent biases; 
d) the vector x;,. (7) has an heterogeneous structure, since it 
consists of quantities of interest for the end-user of the INS 
(namely, p/, and v^), quantities relating pk and v^. to the 
sensor outputs (namely, a^, g/ >i ’, a^, cu/: !>> ") and quantities 
related to the SEMs of accelerometers and gyroscopes (!>/ 
and b/, respectively); e) including the IMU-sensed quantities 
(a/, u;^") in x^ is important since impulsive noise (due to 
hardware instability of low-cost sensors) may affect the IMU 
output and an accurate dynamic modelling of (fc + l)-th step 
sensor orientation ((//R-,) requires the knowledge of the fc-th 
step angular velocity (w/ <>>, ‘). 

B. Dynamic and Measurement Models 

The dynamic models adopted for the elements of x/, (7) 
can be summarised as follows. The Taylor-expansion models 
(e.g., see [ 6 ], [11, Sec. 4.3]) 

1 2 

Pfc+i — Pfc + v/,. • T s + -a k • T s + 


( 8 ) 



and 


C. The EKF 


v fc+1 = v fc + a k -T s + n Vtk (9) 

have been employed for the vectors p/, and Vfc, respectively; 
here T s denotes the sampling period of the INS (1/100 Hz 
in our case) and the vectors n Pt k and n,,/.. are AGN terms 
affecting p/, and v*,, respectively. The model 

afc+i = R T {ql >b ) a fe + g + n a)fe ( 10 ) 

has been used for a/,, where R (q k >b ) is the rotation matrix 
associated with the quaternion <■/)/'' (and thus representing 
the transformation from navigation to body frame), g = 
[ 0 , 0 , —g] T is the gravity vector in the navigation frame and 
n a ,k is AGN. 

A further model relates the orientation of the sensor (rep¬ 
resented by q k >b ) to the angular velocity and is given 

by (e.g., see [ 6 , Eq. (4.11), Eq. (4.20d)] and [7, Sec. 11.5]) 


Qk+i = ex P 0 Ik’” + n -3.fe ( n ) 

where n q j : , is AGN. 

Finally, the simple “random walk” models 

a fc+l = a fc + n a,fc (12) 

«£r=«r*+ I v* (i 3 ) 

bfc+i = b“. + n b a ife (14) 

bfe+i = K + n 6 * >fc (15) 


have been selected for the filtered states a/ and u) b k b>n , and for 
the sensor biases h k and h k , where the {n. *,} terms denote 
AGN contributions. 

Regarding measurements models, simple linear relations 
involving only quantities in the body frame may be adopted, 
thanks to the structure chosen for x*, (7): 

Z k = a k + K + m a,fc (16) 

z fc = <*> b k b>n + h k + (17) 

Here z k = a (see (4)) and z k = (see ( 6 )) denote the 
calibrated force and angular velocity measurements provided 
by the IMU and the vectors m aJ t, rn^./, represent the AGN 
terms affecting the measurements. 

The dynamic models ( 8 )-( 15) can be summarised as 

/(xfc+i|x fc ) = A/'(x fc+ i;q(x fc ), Q) (18) 

whereas the measurement models (16)-(17) can be summarised 
as 

/(Zfc|x fc ) = A^(z fc ;r(x fe ),R) (19) 

where z k = [z k ,z k ] T € K M (with M = 6 ), the vector 
functions q(-) and r(-) are defined by (8)-(15) and by (16)- 
(17), respectively, and Q and R are I) x I) and M x M 
diagonal covariance matrices for the AGN terms. Regarding 
these matrices, it is worth mentioning that a) they may have a 
strong impact on the EKF stability and b) the choice of their 
diagonal values can be based, in practice, on some careful 
tuning procedure (involving D + M = 31 parameters). 


The goal of the INS is the sequential estimation of the 
hidden state vector x fc representing the mobile agent given 
the sequence of IMU measurements {z ( | :b }, i.e., the sequential 
estimation of the posterior pdf / (xfc|zo : fc). Since our dynamic 
model is non-linear (see ( 10 ) and ( 11 )), a non-linear filter, such 
as an EKF, needs to be employed to solve this problem. It is 
important to mention that: a) the EKF alternates a prediction 
step with an update step ; b) it estimates the first two moments 
of the posterior pdf /(xfe|zo : fe), namely, the mean state vector 
Xj. KF and the state vector covariance matrix P™, in a recursive 
fashion. In particular, given x™ and P| KF , the EKF estimates 
(prediction step) [12] 

Xfc+tife = q (xD P£n fc = (J If + Q 

where x™-^ and P™^ denote the (fc+l)-th state mean and 
covariance, respectively, which can be predicted on the basis of 
the information available at the /c-th step; here 3 k = 

1 r x x fc 

is the D x D Jacobian matrix for our (non-linear) dynamic 
model. Then, the EKF evaluates ( update step) [12]: 

Sfc+i|fc = Zfc - r (xfc+qfc) 

S fe+1 , fc = 3 r k Pr+i\ k (J if + R 

K fe+1|fe = p- 1 |fe (JD T s-j 1|fc 

^.EKF _ - I KI , Tf 

X fc+1 — X fc+1 | fc + lV fc + 1 | fc S fc+1 | fe 

P '' EKF /T If TI \f>EKF 

fc+1 — l 1 — 1V fc+l|fc J fcj-r fe+l|/c 

where r k+ i\ k is the innovation residual and Sfc +1 |fc its estim¬ 
ated covariance matrix, Kj. +1 |*. is the Kalman gain, x^U is 
the new estimate of the state vector mean and P/^j is its 
estimated covariance matrix; moreover, J/ = is 

^fc + 11 k 

the M x D Jacobian matrix for the measurement model. 

It is worth noting that: a) in any EKF, at the end of the fc-th 
iteration only the quantities x| KF and P| KF need to be saved 
and this substantially simplifies the INS implementation; b) 
given these quantities, the posterior distribution /(xfc|z 0 : fe) 
is estimated by the EKF as J\f (x fc ; x™, P| KF ^; c) the ini¬ 
tialisation of the INS represent a critical task, since initial 
errors cannot be mitigated by the EKF. As far as the last 
point is concerned, Pq kf = Q has been selected for the initial 
covariance matrix, whereas the initial state vector Xq kf has 
been estimated assuming the foot still in a known position; 
unfortunately, further details cannot be provided for space 
limitations. 

D. Foot Stance Detection 

Even if the EKF illustrated in the previous Paragraph 
includes the sensor biases b/ and 1 )/’ in x/,., due to the 
lack of robust models and, in particular, to the lack of bias 
observations, the tracking of such quantities mitigates but 

1 This matrix cannot be put in a simple analytical form, so that its evaluation 
requires use of computer algebra systems. 



does not completely compensate for sensor inaccuracies. In 
practice, the residual biases may quickly disrupt the INS 
tracking since their effects accumulate over time. The effects 
of these error sources can be mitigated exploiting some a 
priori knowledge about the typical human walking pattern 
and, in particular, the fact at the end of each step the foot 
lies approximately still on the ground for a short period 
(typically, 0.1 — 0.2 s); during such a period, the value of 
most of the elements of x/ c are known a priori and the EKF 
state can be adjusted accordingly. In practice, the EKF can be 
provided with some “pseudo-measurements”, usually known 
as ZUPTs [2], whenever a detection algorithm, processing the 
IMU measurements in parallel to the EKF, detects a “foot still 
event”. In our work, a foot stance detection algorithm inspired 
by [1, Sec. II.C] has been used. This algorithm evaluates four 
logical “condition signals” {Cj, Cf, Cf, Cf} associated with 
the IMU measurements z k and generated as 


Cj = 


Cf = 


Cf = 


ct = 


7a,min ^ 


< 7a,m 


^ 0 otherwise 
1 <T (zf_ 5:i+S ) < CTa 
0 otherwise 


1 


< 7w, m 


0 otherwise 

1 a ( z ts-.i+s) < 

0 otherwise 


for i G {k — F,...,k + F}, where er(xi, x 2 ,xjv) de¬ 
notes the standard deviation of the magnitude of the vectors 
{xi,X2, ...,xjv}, F is the size of the windows used for step 
detection, S is the size of the window used for the computation 
of cr(-), and 7 0jmax , cr ajlnax , 7 w>max and cr„ imax represent proper 
thresholds. An hard detection algorithm based on the condition 
signals defined above has been proposed in [1, Sec. II.C]; 
it decides that the foot is “still”, during the k -th time step, 
if J2 h j=k-F CjCjCj > Here, we propose to use a soft 
variant whose output is the soft foot still (SFS) signal 


k+F 


SFSi 


= p E clcfcfcf 


i—k — F 


which ranges, for the fc-th time step, from zero (moving foot) 
to one (the foot is very likely to be still on the ground). Then, 
whenever SFSfc > 7 SPS ( 7 SFS £ [0; 1] is a fixed threshold), a 
“foot still event” begins and the EKF is fed with the pseudo¬ 
measurements 


1 1;2 = Z XV = [Pfc] 1;2 + m xy,k 

( 20 ) 

0 = z z = [Pfc] 3 + m z>k 

( 21 ) 

0 = z, v = Vfc + m,,fc 

( 22 ) 

0 = z° = a fc + m a ,fc 

(23) 

-g = z ab = R t (q£ >b ) a k + m a b k 

(24) 

iisii = z a6 = K +m a \k 

(25) 


0 = z w = u 4 ' fe> " + (26) 

a = z£“ = b£ - R{q£ >b )g + m b a k (27) 

w = z b k = h k + (28) 


where s is the time step corresponding to the beginning of the 
current “foot still event” (so that p' s KF represents the position 
where the foot is still) and the vectors {in../,.} denote the 
AGN terms of the pseudo-measurement models. To avoid 
discontinuities in the tracked path, the variance of these noise 
terms is modulated in a soft way on the basis of the SFSfc 
signal. In practice, the soft ZUPT pseudo-measurement model 


/ (z\ |x fc ) = Af (z£; r p (xfc), [1 + K p ( 1 - SFSfc)] BP) (29) 


is adopted where z k = [z xy , z z , z v ,..., z b k } T £ R MP (with 
M p = 20); R p is the diagonal covariance matrix collecting all 
variance values of the {m.,fc} terms; the vector function r p (-) 


can be easily derived from (20)-(28); J[ P = dl g ^ x - 


is 


' ^-fc +11 k 

the MP x D Jacobian matrix associated with the measurement 
model (29) and K p is a parameter introduced to modulate 
the variance of ZUPT pseudo-measurements. Note that the is 
the value of K p , the higher will be the variances associated 
to z p k pseudo-measurement when SFS/,. = 7 SFS ; then, as SFSfc 
goes from 7 SFS to 1 , the variances associated to z p k decrease 
smoothly to the values collected in R p . This approach ensures 
that the tracked state vector x| KF smoothly transitions to the 
“reset” values defined by (20)-(28), when ZUPTs are injected 
in the EKF. 

Finally, it is worth noting that the pseudo-measurements 
(20), (21), (22), (27) and (28) allow to “observe” otherwise 
unobservable state vector components and thus to “reset” 
errors they might contain. 


IV. Indoor Navigation Tests 

An experimental campaign has been carried out to acquire 
various sets of measurements generated by an agent equipped 
with the IMU described in Section II and repeating the same 
test trajectory N rep = 10 times in an indoor environment. 
These measurement sets have been stored on a notebook 
and then processed offline. The test trajectory contains long 
straight lines, 90 deg turns, short and long stops (e.g., to turn 
on/off lights, to open/close doors, etc); the initial and final 
positions coincide and the total travelled distance (TTD) 
associated to such test walk is L TTD ~ 300 m. 

An example of the resulting INS-estimated agent path 2 
is shown in Fig. 1. It is easy to recognize that the “drift” 
phenomenon mentioned in Section I is present, although in 
a very limited amount (specially considering the many loops 
walked in the same verse by the agent). 

To quantify the performance of the INS usually the quantity 
£rrD ~ I7IT 11 Po * 01 — Piv F 11 ' s exploited [1], where N s is the 
last time step in the recorded measurement set; of course. 


-Note that the values of the parameters introduced throughout the paper 
and used to produce such results have been properly tuned by means of an 
automated search procedure, but the resulting values cannot be shown for 
space limitations; see [13] for more details. 




Figure 1. The agent trajectory estimated by the INS described in Section III 
for a specific repetition. The checkpoints approximating the ground truth are 
indicated by blue crosses; the corresponding points estimated by the INS are 
indicated by red crosses. 

for a closed test path and an ideal INS, e TT D = 0. In our 
tests, for the N rep repetitions of the test walk, the f TTD figure 
of merit was {1.4, 0.5,4.7,1.5, 7.2,1.6,8.8,10.1,10.4,12.1}; 
these results can be compared with those obtained in [1, 
Table II]; in such contribution, when the magnetometer is not 
employed, the reported range for e Trn is 2 — 10. These results 
show that our INS achieves similar performance to that of 
[1], despite the key difference that in [1] the Xsens MTi IMU 
has been employed. Such an IMU has higher accuracy (and 
higher costs) than the RazorlMU; to quantify such a difference, 
the noise of the IMU sensors can be modelled analysing, 
by means of the Allan variance method, long sequences of 
sensor outputs acquired while the sensor is still. In our case, 
24h of RazorlMU accelerometer and gyroscope data, acquired 
at the sampling frequency f s = 100 Hz have been recorded 
and analysed; the results, in terms of the standard N and B 
coefficients representing acceleration/angular velocity random 
walk (ARW) and bias instability (BI) noise contributions, are 
listed in Table I, together with the results reported in (14, Table 
III] for the Xsens MTi IMU. The comparison between the two 
IMUs shows that: a) the Xsens MTi has better matching among 
the sensors mounted on the x, y and z axis; b) the Xsens MTi 
IMU offers much better accelerometer performance. Moreover, 
it is important to note that the RazorlMU calibration has 
been carried out at a fixed temperature while the Xsens IMUs 
employ temperature-dependent calibration factors. 

In summary, the values of e TTD characterizing our INS are 
comparable to the values reported in [1, Table II] (when the 
magnetometer sensors are not used) although we employed an 
IMU with worse noise and bias characteristics (of course, our 
IMU is also cheaper and thus lowers system costs). 

V. Conclusions 

In this manuscript, a novel INS has been derived integrating 
exact kinematic models, SEM in the EKF state vector and a 
novel soft heuristic to detect foot steps. Our experimental tests 



IMU 

ARW/BI coefficient 

Unit 


RazorlMU 

N = [5.2,12.1,5.6] • 10" 3 

(°/s)/vTfc 

o 

H 

B = [3,18,4.4] • 10~ 3 

°/s 

6J3 

Xsens MTi 

N = [45,41,36] ■ 10 -3 

(°/s)/VHz 


B = [7, 7, 5] ■ 10" 3 

°/s 


RazorlMU 

N = [5.5, 5.1, 7.6] ■ 1CT 3 

(m/s 2 ) /V Hz 


B = [609, 590, 732] ■ 10~ 6 

m/s 2 

o 

o3 

Xsens MTi 

N = [900,950,850] • 10~ 6 

(m/s 2 ) /VTIz 


B = [230, 270, 290] ■ 10 -6 

m/s 2 


Table I 

Comparison between the RazorIMU and the Xsens MTi IMU. 


have evidenced that: a) a good accuracy can be achieved in 
tracking a mobile agent on the short/medium period; b) our 
INS performs similarly to other state-of-art INS PDR solutions 
but uses a lower-cost IMU and does not employ magnetomet¬ 
ers which are often unreliable in indoor environments. Future 
work will focus the integration of map-awareness and radio 
measurements in the proposed INS in order to further improve 
robustness and long-term accuracy. 
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